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(54) CONTROLLER FOR WORK CARRYING APPARATUS 

(57)Abstract: 

PROBLEM TO BE SOLVED: To move a work WK linearly 
along a horizontal line, by preventing the moving 
trajectory of the work from changing into a curve 
deflected in its self-weight direction when carrying the 
work by a carrying robot to the carry-in port of a load 
locking chamber. 

SOLUTION: A vertical-deflection quantity AZ of an arm 
is set by making it correspond to a horizontal-movement 
quantity X of the tip of the arm. Then, a vertical- 
deflection quantity AZ12 corresponding to a present 
horizontal- movement quantity X12 (P12) of the tip of 
the arm is determined from the set content in the above. 
Accordingly, a vertical-movement quantity Z (vertical 
drive command) is so corrected that the arm is moved 
by the above deflection quantity AZ12 in the opposite 
vertical direction to its deflection direction, and the 
vertically drive command is outputted. 
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— A Z i:co*T/SBI^L6^E1S^— 

40 L*X^e>r-Aft«8«^* A Z A Z 

= f (X) «rEttL-C*3Vv-CfcJ:v\ 

[0077] m^-mnmu 3 3 -eta, «^w*&ffifip 1 

f AZ ij&s±EE«^~:7/WDR£Ettrt* L 6^ «b*tb 

(Sc^m^n^) o ra«tcu-ca«ffi«P2^*5 

tt6T-A#i^LSX2^^-r5T--A5 l E;^^ftA 
z 23&«±EE«^ - ^co^:^fs1S^« L 6^ 5> W Hi S *t 
5 (01 2 (a) , (d) mm o 
[0 0 7 8] tW^7y-y^S3 4m 
50 B P 1 0 Sffitt P 2t-M 5 * X<Dffim<D®im L 12* s * 
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mi 2 (b) mm) o 

[0 0 7 9] ^Lt:oPK P2M£H£-£SKLl2±fc: 
(012 (b) , (e) ) o 

looso] asaaMB3 6-c«\ ^-^v>^mr a 

»*Z' , Jl> J 2^4fiK**ttB*SnS. 
[0 0 8 1] -J-ftfofel^V^ 3 s&tf-L-cu-^y V 
^WPlBTa*»a-*-*»^W»L 12±<0#lt^ffifiPs io 
U Ps2, Pll, Ps3, Ps4, P12, Ps5, Ps6, P2^ 
iSf^3 6i:AA$Wo o*»9ffi*BB*&ffifiPl£ 
SS^Pllt^Pfl^j^Psi, Ps2^£ <9*SP^£*i, 

£*U S*/SP12^: i« J FSP2t^lWdS^Ps5, Ps6K 

[0 0 8 2] ^LTI^^y >^«F*JS<7>#jf^ffi«P 
si, Ps2, Pll, Ps3, Ps4, P12, P s5, Ps6, P2 

( f ) ) o 20 

[0083] ftt^ttmi iic7F-r&?ic&?>y->'yi) 

^rffifi P l2lc#JSi-5T— A#tf b*X 12^##> £>*x, 

ror-^f#tfu*xi2^»jct-sr— ^5fe«s«^.*A 

Z1236S»JSH«L635»6>*«>e>^S. LT r <£>T-A 
#«U*X12^*HS-r-5«S^«E*AZ12dS, -klB^tf) 
fcT— A3fe«J«**A Z12«rEAK*i**-C**bix 
So o*!9r— A{*tfL*X12^a-i£i-*»**lE*A 
Z12^H1 1 C0fti|ftL4^b3ftfe^tt^r £tC&5o 

[0 0 8 4] *fcJB«BBttffi«Pll-*3»6«**|iE* 30 
AZ1J&SW*1CL-C#«>&ix5 (1^1 l#BB) • 

[0 0 8 5] o#*(cmffi^}f^ffieP12Sr, ITttll 

ttto%affiO»«ffi«Pl2^*5**6«*1i]E*AZl2i: 
Jf^M^ffiB P 1 K*3tt 6 «£^«ijEfi A Z 1 k (Dm A Z 1 2 

- A ZltfS^ktbSo 
[0 0 8 6] -tLTlt^ffittP12^*3JtS*:*Offi»*g 
<£Z (=0) lC»L-C±K«*AZ12-AZl«r*P*.« 

ririao "cn2®)ft^ z ^ffiiE ^t^r. oMiE § titcmm 

[0 0 8 7] &&<Dm&GLW& P 12<7) k # SrWt- £ t) H 

«Pn^»iCr5a^«3E*Zn^*«>b^ ^fficoit^ 
ffi«Pn(c*5»tS**^»jt^Z (=0) td^LTfil 
^A Zn- A ZlSrftJASr t^J:o-C«»»*Z3ft«*tjE 
SixrwMjESn^BBidlt^Z' WT(tni:»U 

[0 0 8 8] — ^mffi^lf^BP^^, MhIWI 2, 
S2*l 3^»i-S«»»« J 1, J2l^t5^I 

^^tT^n^o ^*t>*,«aE^j8^ffiHPi2(c:^"rs so 
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12dS»bttS#WiB»tB^ J 112. J 2\2H>m&&^& 

[0 0 8 9] *Urjg*ffiBP12«C*3ttS«2SBlii* J 1 
1235SffilsIttl 2(C^LTtU^^tl^^ < tt>^KlJ : g^J 
2 12#»2(*1 3K#LTfcH*j£*l5o 

[0 0 9 0] a*©»«ffiB* J P 12£> £ # Sr0»]^ tOR 
MUyS:^«l<7)»^ffl:fiPnOt#t>IS]«^LT, 

~<DT-j*to&\^&xni!>mhtiz&%Ammm^ j in, 

J 2nsftSiS!aS*JCJ:oT3R*b*u«»iB«J lnsMfclSWi 
1 2*C»LTUi**nSi:4: t^W»»^J 2nM(S2 
Wl 3(C^Lrtti^)$tL5o 

[0091] f&j#m 3 8 -m, &mmm n, 12, 1 
[0092] i-ft*?t>*^^7 3 7 ^ufy/y >- 

^«pMTb3&5gaa-rSSI-#ie^ffifiPsK Ps2, PI 
1, Ps3, Ps4, P12, Ps5, Ps6, P2f-*3(t SKItrfB 
&&®mW3 8{cA^^tl5 0 

[0 0 9 3l m,&<Dt$^tiLW&Pi2-e&>z>k-fz>k, r. 
©»4Mfc«Pl2fc»JS^6»iMB*Z' (=Z + (AZ 
12- a zi) ) asA^sn-ofctK r<aigftj§^z' ^ 
Si:r±Ttti lffl^-^Miofit, XS^ffiflid 
*l6o r^ft±T«i l^fi^stz' (=z + 

(AZ12-AZ1) ) fcfttiSKjSftSo 

[0 0 9 4] S^if <fr{fcB* s P 12C0 k # t 9 R 

MU^Sfl&<75*g^ffiBPnOi:#fcp]«^UT, S,£E<£> 
^g^^^^:fiPn^^-r5ll^^^t^rZ , (=Z + (AZn- 

azi) ) ^A^£n, rcoirayg^z' (c«;cr±T 
tliliOT-^Miwfii, iWEdSIW»S*bS. ' ^ 

te*±Tttl lttf&ilE^ftSZ' (=Z + (AZn-A 
ZD ) »tB»Sn*o 

[0 0 9 5] o^tC^lHjtt 12, S2il3 0>fH»Ko 

[0 0 9 6] m&<n$£^&W:& P 12X+ k~fZ>b, r 
©JS^ffiBP^^ast^rSKM** J 112. J 2 12*s A 

^^nr^o^, r^igttJt^ j 1 12, j 2mcfscxm 

iHlttl 2fflW^M2, I2H1 3ffl(O^M3(0 
fig, iSS* s -tix-?:ttf&J»SttSo rco^m^lHl»l2 
^gj 112fcttSKtb$tb5cb^^^^2ttl 3*s£ffi 

j 2i2^rttazKi*tt6 0 

[0 0 9 7] Sffi^^ffifi^ P 12CO i: # ^r^J(- kViSL 

w^tzfim<z>m<$GLmpn<Dkz hw\m^\^x. m£<D 

m^&SPnlcMfc-tZmW}^ J In, J 2n#A*<* 
ti, roWftJg^J In, J 2nKJCCTffi[gttl 2ffiO 
^t-^M2, ^2ttl 3fflOT-^M3©fit^ iiS* 5 
^n-^ttSJP^ttSc rco^mS^lHll*! 2d*ft£j In 
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[0 0 9 8] £l±.(D& 0 fC ltr-Aft« 1 4 tem&ffl 
tnSi:, 7^16, l 7©jfe«l 4 4 « 

[00 9 9] • PTP|lJ» 

j^tiu i 3 £0N:#j8 LTia 9 ^tT^ttssjai^aort 

tlCO^TMt^o HI 13 (a) IIT-Al 6, 17 

v>Wi%&7F't±mm~e&*)s mi 3 (b) , (c) 1*7 

fiB (ffi^BH*&ffi«) Pl^e>SSffiHP2*-C»tti-S 20 

[0100] PBI 9 ^^-Tct 5 S«ffi1ER£» 3 1 
Tttr-AJfeMl 4<DB«ffi«P23ftSKS**tSo fci 
X.tf7~-A5te*l 4 0@gttlP2tt7 1 ^-f>'^J: 

^«14<7)mffifiB (»^H*6ffiB) Pl^tfcWStt 
5, t^tf#Sl«lU 12. 1 3\Z.mtbtl1tm 

«pi3fls*m**ts (mi 3 (a) #m) o 

[0101] ^fi^ttJSP 3 9 "Ctt, m 2 T—J* 1 7 co 30 
[0 10 2] rr-Cl2l 0(j:$2 7-Al 7coieI$c^S 

j 2 k&mxfa&mmz k<om&*7*-$-o hiiocohl 

Z^JF>^0^i"5o H01 0cott#|L3te3?2 7~ AH 

[0 10 3] STj»3tLfeJ:5«rJlli»||oj7-^IBaS 

hRK^LTPTPW^Ifflt^^, 127 40 
-A 1 7(0|Elte£ffi J 2 (fg 2 M 1 3 COHEKft J 2 ) 

±T**i io»»*AZi:(DiR|^ttaT<oH«3ft s * 

[0 10 4] 

A Z =K • ( 1 + J 2/1 8 0) — (2) 

[0105] AZ = a • J 2 + b ••• (3) 

f:f:La , b«:3£»T-fcS 0 

[0 10 6] ^rT*±|2 (3) ztaS, $27-A 1 7 CO 
0^SJ 2 4, a**|iE*AZ4:<oBB«*r«+iEffilS: 50 
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4 U-CIE«L-C*5<. 

[0 10 7] ±EiSfiia; (3) «;^bt#e>4x6*HCB8« 
StEI 1 0 JCL14 lt/Tto 

[0 10 8] Ell 0ld*5V>-Cifiia* (3) ^e>#btt5 
tttk L 1 rtcSMBIB****"!-** L 6* jE*RC £ iir/c fc 

[0 10 9] *JMfiJg»-ef4ififil* (3) 5S«rE«*-fr 
X^ZtK ittfflA (3) *a>b»fc*u5SB2r-A|5HE 
ftgj 2 k«^SjE*AZi:0*HCB8«LlS:E1*^— 

[0 110] m***MtiM3 9"?li, ^WfiiPl 

^*3»t*!R2r— AiateAjt j 2nc»j6-t"sa**jE 
«:a zi3&s±Eififfl* (3) *3&*e>jnusna. h«k 

LrSSttfiP2(C*3(t^^2T-AlHl«n^a J 2 2fc» 
J«^61i**|jE*AZ2*±EiE(Ha (3) strata 
(Hi 3 (a) . (b) #H8) 0 

[0 111] B«ffi««jEfflU OtU S«fflBP2"C 
co_bTtti iJc#-T5«BiO?»»^Z*s*tjESn6 0 

[0 112] t-3fcto%B«ffi«P2Jci3ttSa**|jE* 
AZ2i:»*B*6tifc«PllJi*5ftS«**liE*AZl4:W 
*AZ2-AZld«**6ixS. *U-CH«ffilllP2lc*3 
ttS#*^W»iB^Z (=0) li#Lt±IEHSAZ2 
- A Z 1 **0 i S r i C <t o t SBffi* Z IE S 5 

((Eli 3 (c) mm) o 3(f) 

[0 113] te*5B«ffi«P2^*5*t5* 5 PB«l*B« J 
1, J 2tt*|]E*ixftl\ Hll 3 (d) ttft|sINll2iC 

j 1 o* 9 watt 1 2^-^M2c^t 

tSagJI^/TltV^o £fc|I)13 (e) fif 2(* 
1 3K»-r5Sa&«<fr J 2o^^2#l 3<£HE— *M 

[0 1 14] PTPSJIBlCOii^Cttfoiai 3(d), 

(e) , (f) »c«-t-±5^»«BI«Ml(tKP1^6>H« 
tt«P2^5J«+S*l?<OiS«JB«^*D«jS/<^— ^tt 
#J§E»«I11, 12, 1 3-C— SfeLTiSt), a>o»fls«P 
rp1f^#l2ibl*l 1 , 12, 13T*-SlW5c o*9 
#5*ftJB«^*iaKIBoi*IB t al*^L<, ^^c^SIS 

m^fflt et^b<, &fcttttKm0i$n t d^t 
[0115] i -e», i^-^^y y^WTa^ 

M-r*»fc«nMiki l. 12, 1 3k#t5a*» 

^Z r , Jl, J 2&£.f&£timt)£tiZo 

[0116] -r^*?^-^^ 3 ssr^L-tiJ-^y > 

^WplBTajftsttiBi-SttU:, Hi 3 (f) fc^i-jSKS 

MTa^aa-i-s»^, H3 (d) K^i-isajt^ 
i^ai^aaE©*«it«*sii!ia*i 2ffl<o^~ 

^M2{C^LTtti^$tt, Hll 3 (e) fC^-TilSlt^ 
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[0 117] «J»ffl4 2"Ctt, #IES(l$ftl 1, 12, 1 

[0 118] -r?fe^^^^^7 3 7*^Ltfy^y >- 
miBTbds«ai-6*^iB«JB«*sfW«itt4 2KA* 

£*ls 0 *LTroig«»«a^»&fts<fc5#e-*M 10 

1, M2, M3^re»»JI»$ixSo 
[0119] J^iiCQj; 5 K LT7-AftH 1 4 liJg^BH 

s 0 ^itr^, #+^y >^w« tnWc, r- 

A16, 17 GDft« 1 4 ^^2/1*] t ttR»©»aC*|nl 
ZK, (3) *l£g<K«**BjE*26AZn-A 

Zl«ttftK*»1-6 ± 5 l^»Ifcfrrtimft*Z<o*|lE* 
ft^frVTV^o Ell 0tC*5(tSL2ttffijE«^a^*O 

»IWcJ:ixrijff«a; (3) ^tcS^#«&K*fPiPSiftz 20 
sp»HLic«oriMM*^#»i-5. osop— *wk 

[0120] rrr*±lE (3) ^«6or«&K*rS]iHifi 
fiZSrffljELfcr^lci^^tco^THl 1 4*#fiftL 

[0121] 014 (a) ttJiE (3) AMS^SifilH 
ftftlilfriiESAZ*:**^*^*:*^, 014 (b) 

IE*A ZSr^^yta-frSr^LTV^Sp 
[0 12 2] !7 — ^KKiloaRjy bRKOSiMlcio 
■Ctt. T-A5fe*l 4tJB*Mttffi«Pl^bB«ffiJl 
P2*-C»»**5*»l8«e!>«b^, 7^Ml4^ 
Jfrfr MteffiB P 1*» b B SfiCfi P 2^ffrco * PflS© P 3* 
^»»S*r©*BBffi«P3^-a#JkS*6^IMII 

[0123] Ell 4 (a) ^^i-*3S16?Kffi<^*J»<7># 

-g^t*, jtE (3) *^aoTa«jRP2ic*3f+s** 

*tjE*AZ2^3Rfe&n, ^MjfiPStCdottS^ffilEfi 40 
AZ3^##><b*L6 0 ^LTI^IC: (3) «otlT 
WllOl»iAZ«ftt5o Lfc*otli/SP2 
*-er-Ajfe«i 4^^tt^^fc<3r#^ + K^P3il^ 

fl:A Z3W:— Srt-So o* 5 H*jKP2fcS3*'T*0>» : f 1 IB 
^P3iii^B^^r— i>5fc#U 4cojiS£ *M^P3"C— 

[0 12 4] ^tb^^LTll 14 (b) <Dm&lZte, _h so 
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E (3) ^i(iI/^S«ot@^P2l^(t5i 
^f£iEffiAZ2' /!)>#£><b*t, *W,£P 3^*31* SJftWfi 
IEfl;AZ3' 3dS*«>e>ix5o ^ LT±E (3) 5£t::$Eo 
t±T«illOB»iAZ^kt5o L^otlg 
;£P2£-Cr-i>jfciBl 4*»»$^fc££<0*rajKP3 
iiifi^pO«^ffljE*AZ3 (rhli (3) 5£{cg<5£# 

btL5) *ra^:P3"e— jar— ^3t«8i 4«rffihs 

■frfefc#oatt*IB^P3lc*5»t*»**tjE*A Z3' 

r.i:td^5o o*t) aa^P2f-ss*r*^*ia^P3a 

i®f$<7>r-^5fc^l 4<7>iii£^ *M/£P3T-J.#lh 
£ii:fc<t#<7>r-.Mte*8l 4(7>i«St(OM-eKSItt*i: 

[0 1 2 5] £JUb0>«fc 5fc*3KJt»«lcj:tttf, StRjft 
P2^*OtM^P3iiiSB#^r--Aifej8l 4cOi^$ 
fc, *IB^SP3-C—B.»JtS-e:fci:#a>r— Ajfe*l 4 

[0 12 6] ste*5***»«t?W:, !7 — *«Sa£o#:y h 
RIOjglHir — ^ 1 6 N 7C0lt, ? — ^ 

as, i7— ^wK^a**s»3fco*iar— ai e, 127 

[0127] c PM'M<nt%&^\^ m\B\T — A 16, $ 
27- ^1700^4, !7-^WK(Dit(C^Ct7-^ 
tt3ttttt ^ L tt«^1ijE* A Z £E« S -&X 43 t* tf <t 

[0128] SfcPTPM»o»^i:iJ, J^sr-i* 1 

6, S2 7-A17 01I, !7 — ^WK^ltCJSCT 
±lEi£ffi5£ (3) *^*5lt5«*a, bSr^«)tt«J: 

[Ell] H 1 17- ^JBaSnaK y h©**«r 

[H2] i2li^W^7-^t8iD^5' 

[in 3] H3iisiifc»««>«a^7-A*:«-r±ffiia'c 

[114] i4 (a) , (b) J2!7- MCfc 
[15] H5tt!7 — *KftaSo#2/ MdcfcoT^-^Jg 

So 

[0 7] IU7fi||^ffi(7)!7-^^n^> hor-^ 

[B9i H9tt*ssw»«>»j«)«i»^ci y^m-cfeSo 
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4$P2 0 0 0 

16 



[eh o] mi onm2T-M>fi&tift&&W}mk<DM 

[Ell 1] Ell l&T—J*m$LAb&\E&m&b<OM 

[Bi2] ai2 (a) - (f) «0 8 \c*tj& vxum 

[|13] Ml 3 ( a ) - ( f ) teH 9 CM LTW 

»a*ttwi-6iat?*>6. 

[Hi 4] HI 4 (a) . (b) 1±T—*ffcMbMfrHl 
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